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Abstract — The  low  power  requirements  of  many  small  radio 
modems  suggest  that  robust  operation  is  best  attained  when 
the  transmitter/receiever  pair  is:  (1)  separated  by  less  than 
some  maximum  distance  (Range);  and  (2)  not  obstructed  by 
large  dense  objects  (Line-of-Sight).  Therefore  to  maintain  a 
wireless  link  between  two  robots,  it  is  desirable  to  comply 
with  these  two  spatial  constraints.  Given  a  swarm  of  point 
robots  with  specified  initial  and  final  configurations  and  a  set  of 
desired  communication  links  consistent  with  the  above  criteria, 
we  explore  the  problem  of  designing  inputs  to  achieve  the 
final  configuration  while  preserving  the  desired  links  for  the 
duration  of  the  motion.  Some  interesting  conclusions  about  the 
feasibility  of  the  problem  are  offered.  An  algorithm  is  provided 
and  its  operation  is  demonstrated  through  both  simulation  and 
experimentation  on  Koala  Robots. 

I.  Introduction 

Recently  much  attention  has  been  given  to  maintaining 
network  connectivity  in  swarms  of  mobile  robots  equipped 
with  low  power  wireless  transmitter/receivers.  Power  limi¬ 
tations  dictate  constraints  on  the  relative  distance  between 
two  communicating  robots  within  the  swarm  (referred  to  here 
as  Range  Constraints).  Many  other  groups  have  developed 
control  frameworks  for  maintaining  swarm  connectivity  under 
range  constraints  -  often  in  obstacle  free  environments.  We 
discuss  some  of  these  works  below.  However  considerably  less 
attention  has  been  given  to  Line-of-Sight  Constraints  -  neces¬ 
sitated  by  difficulty  of  reliably  transmitting  wireless  messages 
through  large  dense  obstacles.  In  addition  to  these  constraints 
the  robots  may  have  some  overall  motion  objectives  (either 
individually  or  as  a  group). 

In  this  paper  we  address  the  problem  of  navigating  the 
swarm  to  a  specific  final  configuration,  while  maintaining 
a  pre- specified  list  of  wireless  links  between  robots  (Range 
plus  Line-of-Sight).  After  a  review  of  related  work  below,  we 
provide  a  formal  problem  statement  in  Sect.  II.  We  consider 
existence  of  solutions  in  Sect.  Ill  and  discuss  a  key  attribute 
of  any  acceptable  solution.  In  Sect.  IV  we  introduce  potential 
fields  for  Goal,  Range  and  Line  of  Sight  objectives.  Sect.  V 
discusses  how  to  compose  these  sometimes  disparate  objec¬ 
tives  and  provides  a  computational  algorithm  for  assigning 
motion  directions.  Simulation  and  hardware-based  experimen¬ 


tal  demonstrations  of  the  algorithm’s  operation  are  included 
in  Sect.  VI  followed  by  concluding  remarks  in  Sect.  VII. 

Much  work  has  been  done  in  the  area  of  swarms  and 
flocking  recently,  we  only  mention  the  most  closely  related 
work  in  an  effort  to  distinguish  the  class  of  problems  we 
consider.  Due  to  space  limitations  this  discussion  is  by  no 
means  comprehensive.  We  loosely  categorize  work  in  this  area 
according  to  the  following  identifiers:  1.  fixed/variable  relative 
pose;  2.  centralized/decentralize  control;  3.  fixed/dynamic 
connection  topology;  4.  individual/s  warm- wide  objective(s); 
and  5.  obstacle/obstacle-free  workspaces.  For  example,  the 
problem  of  Formation  control  is  considered  in  [1].  The 
basic  problem  involves  fixed  relative  pose  among  the  swarm 
members,  centralized  control  (i.e.,  leader),  fixed  connection 
topology,  swarm-wide  objective  (leader  position)  and  obsta¬ 
cles  in  the  workspace.  In  contrast  [4],  [5],  [9]  consider  the 
Flocking  Problem.  No  relative  pose  is  prescribed  among  the 
the  swarm  members  and  no  leader  is  prescribed.  Instead  a 
range  constraint  and  velocity  matching  controller  result  in  a 
collective  behavior.  The  flock  converges  to  some  steady  state 
velocity,  although  each  member  does  not  persue  an  individual 
objective.  Fixed  and  dynamic  connectivity  are  considered 
but  no  obstacles  are  present.  In  [8]  the  flocking  problem  is 
also  considered  in  a  slightly  different  framework.  A  swarm 
wide  objective  is  supplied  and  some  obstacles  are  considered, 
connectivity  is  dynamic.  Our  work  is  characterized  as  follows: 

•  unlike  Formation  Control,  no  relative  pose  between 
robots  is  specified  and  no  lead  robot  is  designated; 

•  we  do  not  explicitly  address  dynamic  connection  topol¬ 
ogy  in  this  paper; 

•  unlike  Flocking,  each  swarm  member  has  a  distinct  goal 
position  rather  than  a  swarm  wide  desired  velocity; 

•  we  consider  obstacles  avoidance,  but  unlike  the  work 
considered  above,  we  also  account  for  their  affect  on 
connectivity  via  the  line- of- sight  constraint. 

Perhaps  the  most  closely  related  work  is  [2]  in  which  a 
geometric  connectivity  constraint  (range),  an  initial  and  final 
position,  and  a  desired  communication  graph  is  specified. 
However,  obstacles  prevented  the  presented  solution  method- 
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ology  from  being  applied.  In  addition  they  consider  multi-hop 
network  connections. 

II.  Problem  Statement 

Given  n  point  robots,  let  qi  £  M2  be  the  state  vector  of 
robot  i.  The  robots  operate  in  a  subset  of  the  plane  CcM2 
which  is  populated  with  obstacles  defined  by  compact  sets 
Oj,  j  = 

Motion  is  generated  according  to  the  dynamics 

4i=Ui  (II.  1) 

where  Ui  £  U  C  M2;  and  qi  is  only  permitted  to  evolve  in 
the  free  space  Cfree  —  C  —  Ujli  Oj.  Occasionally  we  will 
use  q  £  R2n  to  denote  the  swarm  state  -  the  concatenation 
of  states  q\...qn\  u  to  represent  the  concatenation  of  the 
input  vectors;  and  q  =  u  to  represent  the  collective  swarm 
dynamics. 

Any  given  swarm  state  q  induces  a  communication  graph 
G(q)  =  (V,E).  Each  vertex  in  the  graph,  vi  £  V  represents 
a  robot  and  each  edge  e^-  £  E  represents  a  wireless  commu¬ 
nication  link  between  robots  i  and  j.  The  edge  e^-  is  added 
to  the  graph  if  both  of  the  following  conditions  are  met: 

1)  Range :  d(qi,qj)  <  pmax  where  pmax  is  some  positive 
constant  indicating  the  maximum  effective  range  of  the 
transmitter;  and 

2)  Line-of-Sight :  3x(a)  £  Cfree ,  Vce  £  [0,1],  such  that 
x(a)  =  aqi  +  (1  —  a)qj , 

note  that  d  indicates  distance  as  measured  by  the  Euclidian 
metric.  Both  constraints  model  the  power  limitations  of  small 
wireless  transmitters  discussed  in  Sect.  I.  A  configuration  q 
is  said  to  be  connected  if  the  induced  communication  graph 
G  is  connected  (i.e.  if  for  any  node  pair  i,  j  there  exists  an 
edge  path  of  arbitrary  length  between  them). 

We  are  concerned  with  the  following  problem  (see  Fig.  1), 
which  requires  the  entire  swarm  to  move  to  a  desired  position 
while  maintaining  certain  communication  links,  G*. 

Problem  2.1:  Given  an  initial  connected  configuration 
q°  =  q(t°)  and  a  final  connected  configuration  qf  and  a  graph 
G*  such  that  G(q°)  D  G*  and  G(qf)  D  G*,  determine  a 
function  U  :  [t°,tf]  — >  U  such  that 


1)  q(tf)  —  qf  (i.e.,  Goal  directed  motion); 

2)  G(q(t))  D  G*,  Vt  £  [t°,tf]  (Line-of-Sight  and  Range). 

III.  Existence  of  solutions 

Clearly  there  are  certain  combinations  of  the  free  space 
Cfree  and  the  desired  connectivity  graph  G*  for  which  the 
problem  may  not  have  a  solution.  Furthermore,  even  when  a 
solution  exists,  there  are  certain  classes  of  algorithms  inca¬ 
pable  of  solving  the  problem.  The  concept  of  homotopy  [6] 
is  intimately  related  to  these  existence  questions. 

A.  Homotopy  Definitions 

If  n,T2  :  [t°fif]  — »  Cfree  are  continuous  maps  (paths),  we 
say  that  n  and  r 2  are  homotopic  if  there  exists  a  continuous 
map  T  :  [t°fif]  x  [0, 1]  -A  G/ree  such  that 

T(t,  0)  =  n(t)  (HI- 1) 

T(t,  1)  =  r2(t),Vf.  (HI -2) 

If  such  a  function  exists,  we  say  T  is  a  homotopy.  Note  that  we 
do  not  require  the  endpoints  to  remain  fixed.  This  homotopy 
defines  an  equivalence  relation  on  paths. 

If  r(t°)  =  r(tf)  the  path  is  considered  a  loop  A.  We  can 
apply  the  homoptopy  equivalence  relation  to  loops  as  well. 
The  trivial  loop  is  the  constant  loop  A  (t)  =  A  (t°). 

Of  particular  interest  in  this  paper  is  the  straight-line 
homotopy 

T(fs)  =  (1-S)n(t)+Sr2(t),  (HE  3) 

due  to  its  obvious  connection  to  the  line  of  sight  constraint.  If 
two  path  n ,  t 2  have  a  straight  line  homotopy  then  the  line  of 
sight  constraint  is  preserved  for  all  t.  If  the  range  constraint 
is  violated  at  any  point  on  the  trajectory,  the  straight-line 
homotopy  can  be  used  to  correct  the  condition. 

B.  Intrinsic  lack  of  solution 

Naturally  in  the  case  when  G/ree  is  not  path-connected, 
and  q°  and  qf  lie  in  different  connected  components,  there  is 
no  solution  to  the  motion  planning  problem. 

Furthermore,  if  G/ree  is  multiply  connected  and  G*  con¬ 
tains  cycles,  solutions  do  not  exist  for  all  choices  of  q°  or  qf . 
For  a  given  cycle  Gc  C  G*,  one  can  connect  the  points  q° 
corresponding  to  the  vertices  in  the  cycle  to  form  a  loop  A° 
using  straight-line  segments;  likewise  a  corresponding  loop 
A f,  using  qf ,  can  be  constructed  using  the  same  vertices.  See 
Figure  2  for  an  example.  If  these  two  loop  are  not  in  the  same 
homotopic  equivalence  class,  it  implies  the  loops  wrap  around 
the  obstacles  in  such  a  way  that  is  impossible  to  go  from  q° 
to  qf  without  disconnecting  some  edges,  then  no  solution  to 
the  problem  exists. 

Remark  3.1:  To  ensure  the  existence  of  solutions  in  this 
paper  we  only  consider  path-connected  free  spaces;  and 
q°,qf  such  that  loops  corresponding  to  any  cycles  of  G*  are 
homotopic  to  the  constant  loop. 
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Fig.  2.  Frames  depict  example  of  a  combination  of  G* ,  q°  and  qf  which 
are  not  feasible.  Loops  in  left  and  right  frames  are  not  in  the  same  homotopic 
equivalence  class. 


C.  Attribute  of  Complete  Solution  Algorithms 

As  remarked  earlier,  in  order  to  maintain  an  edge  e^-, 
Vt  £  [t°fii],  there  must  exist  a  straight-line  homotopy 
between  qi  ( t )  and  qj  ( t ) .  Intuitively  a  necessary  (not  sufficient) 
condition  for  such  a  solution  is  that  paths  qi  (t)  and  qj  (t)  must 
pass  around  the  same  “side”  of  an  obstacle.  See  Figure  3. 
Therefore,  if  G*  is  connected  all  robots,  in  some  loose 
sense,  must  collectively  pass  around  the  same  “side”  of  every 
obstacle-  i.e.  the  swarm  cannot  “split”. 

Remark  3.2:  An  interesting  interpretation  of  this  is  that  a 
truly  distributed  controller  is  incapable  of  solving  the  problem 
for  arbitrary  initial  conditions.  Either  some  “lead”  robot  must 
select  a  path-class  for  the  entire  swarm  or  some  type  of 
bi-direction  messaging  must  be  used  to  reach  a  dynamic 
consensus  on  path-class  selection. 

This  notion  is  difficult  to  formalize  however.  The  traditional 
path-homotopy  equivalence  relation  does  not  apply  because 
the  end  points  of  qi  ( t )  and  qj  ( t )  do  not  coincide.  Also,  general 
homotopy  does  not  preserve  the  line-of-sight  constraint;  and 
the  straight-line  homotopy  does  not  induce  an  equivalence 
relation  (it  lacks  transitivity).  Instead  (see  Figure  3)  consider 
the  loop  resulting  from  A ij  =  [ qfit )]  •  [qi(fi)  -A  qj(t^)\  • 
fe'W]-1  ’  [Qj(t°)  Qiif0)]-  Requiring  the  paths  qfit)  and 
qj  (t)  to  be  on  the  same  “side”  of  the  obstacle,  means  this 
loop  is  homotopic  to  (in  the  same  equivalence  class  as)  to  the 
constant  loop. 


Fig.  3.  The  left  frame  illustrates  a  situation  where  Line-of-Sight  is  not 
maintained  (no  straight  line  homotopy  between  paths;  loop  is  not  homotopic 
to  constant  loop).  The  right  frame  shows  two  paths  that  maintain  Line  of  Sight 
(straight  line  homotopy  between  paths;  loop  is  homotopic  to  the  constant 
loop). 


3)  a  Morse  function  (i.e.  its  Hessian  is  nonsingular  at  the 
critical  points); 

4)  smooth  on  Cfree  (i.e.  at  least  C2). 

As  an  example  consider  that  ,  in  the  simplest  case  of  cir¬ 
cular  obstacles  in  a  circular  workspace,  a  navigation  function 
for  robot  i  can  be  defined  as: 


<prl(n)  = 


_ d2 (Qi,Qj ) _ 


(IV.  1) 


Where  Oj  is  obstacle  j,  Oo  is  the  boundary  of  the  workspace 
and  the  parameter  k  must  be  selected  high  enough  that  all 
local  minima,  except  at  q{ ,  disappear.  The  selection  of  k 
makes  it  difficult  to  compute  navigation  function  for  dynamic 
work  spaces. 

Remark  4.2:  It  is  known  that  workplaces  with  M  obstacles 
will  inevitably  possess  M  saddle  points.  Note  that  emerging 
from  each  saddle  point,  is  a  stable  manifold  connecting  the 
saddle  to  other  extrema.  Initial  positions  on  different  sides 
of  these  manifolds  evolve  in  different  path  classes  around 
the  obstacle  associated  with  the  saddle  point.  Therefore,  if 
eij  £  G(q°)  but  the  line  segment  connecting  ql(t°)  and 
qi  (t°)  crosses  the  stable  manifold,  the  line  of  sight  constraint 
between  i  and  j  will  not  be  maintained. 


IV.  Potential  functions 

A.  Review:  Navigation  Functions 

In  this  paper  we  use  Navigation  Functions  as  the  basis 
for  ensuring  the  goal  completion  portion  of  the  problem 
(q  qi).  Navigation  Functions  are  artificial  potential  fields 
that  simultaneously  provide  obstacle  avoidance  and  almost 
everywhere  convergence  to  a  goal  configuration  [7]. 

Definition  4.1:  Navigation  Function :  For  robot  i,  a  scalar 
map  fif00'1  :  Cfree  — ^[0, 1]  is  a  Navigation  Function  if  it  is: 

1)  polar  at  q{  (i.e.,  has  a  unique  minimum  on  the  path 
connected  component  of  Cfree  containing  q-); 

2)  admissible  on  Cfree  (i.e.  it  is  uniformly  maximal  on 
the  boundary  of  Cfree ); 


B.  Range 

The  range  constraint  dictates  that  if  £  G*  then 
d(qi,qj)  <  pi nax-  This  is  enforced  by  a  potential 

/■ range /  \  JO  ^  Pmax 

<l>ij  =  i  42  (  ^  2  M  w 

(d  \QiiQj)  Pmax  d\QiiQj)  ^  Pmax- 

Note  the  potential  only  posses  minima  at  configurations  where 
the  range  constraint  is  satisfied,  but  is  not  strictly  a  navigation 
function. 

C.  Line-of-Sight 

If  two  robots  qi ,  qj  such  that  £  E,  are  in  danger 
of  loosing  line-of-sight,  it  means  one  of  them  is  occluded 
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OL 


Fig.  4.  Geometry  of  the  line  of  sight  problem,  required  to  compute  cj)l°s . 


from  the  other’s  view  by  an  obstacle  as  seen  in  Fig.  4.  The 
line  connecting  them  at  the  last  time  when  line  of  sight  was 
satisfied  is  referred  to  as  the  occlusion  line ,  OL  (see  Fig.  4). 
The  line  of  sight  constraint  is  enforced  by  a  potential: 


4>l°js(qi,qj )  = 


o 

<P(Qi,OL) 


if  L.O.S. 

else 


(IV.2) 


where  d(qj,OL )  denotes  the  distance  from  qi  to  the  occlusion 
line  defined  in  the  usual  way.  Note  the  potential  only  possesses 
minima  at  configurations  where  the  line-of-sight  constraint  is 
satisfied,  but  is  not  a  proper  Navigation  Function. 


V.  Parallel  composition 

At  any  time,  qi  must  select  a  direction  to  move,  which  goes 
toward  its  goal  position  (ideally,  qi  =  —  -&pf9i°a\qi)),  and  for 
each  corresponding  edge  e^-  in  G*,  it  must  maintain  range 
(ideally  q{  =  and  line  of  sight  (ideally 

q{  —  —JLfyosfai^qj)).  However,  it  is  not  strictly  necessary 
to  use  these  traditional  choices  of  motion  directions. 


A.  Theory 

Proposition  5.1:  Any  control  law  u  (even  a  discontinuous 
one)  which  satisfies 


d_ 

Oq 


4>(q,t)  ■  u  < 


d^>{q,t) 

dt 


(V.1) 


is  acceptable  and  will  stabilize  the  system  to  the  minima  of 
f  [3]. 

A  potential  function,  f  is  essentially  a  Lyapunov  function. 
Provided  <j>(q(t))  <  0,  Vt  we  can  show  q  approaches  the 
minima  of  the  potential  function,  since  a  selection  of  u  in 
accordance  with  the  proposition  produces: 


(v2» 

Said  another  way,  all  control  laws  that  satisfy  eq.  V.l  create 
vector  fields  which  possess  a  Common  Lyapunov  Function, 

<p. 

In  the  case  of  ),  there  is  no  explicit  time  depen- 

dence  so  the  partial  with  respect  to  time  vanishes.  In  addition, 
it  is  uniformly  maximal  on  the  boundary  of  Cfree ,  so  its 
obstacle  avoidance  properties  are  preserved  by  all  such  u  [3]. 
For  functions  such  as  (j)los(qi,  qj)  or  fran9e(qi,qj)  there  are 


two  ways  to  apply  this.  First  one  could  consider  <fi  to  have 
no  explicit  time  dependence,  but  robots  i  and  j  are  actively 
working  in  concert  to  achieve  f  by  each  selecting  ui  and  Uj 
to  decrease  <fi.  In  that  case  select 
d 

-Ui  <  0  (V.3) 

dqi 

"Uj  <  0.  (V.4) 

Alternatively,  if  only  one  of  the  robots  is  actively  working  to 
reduce  </>  then  the  second  robot’s  influence  can  be  viewed  as 
an  explicit  time  dependence 


x  9  X!  4.\  ,  d(t>(Qi,t )  /  n 

<t>  =  -nQi,  t)-Ui  +  7^ —  <  o. 


(V.5) 


Where  the  partial  with  respect  to  t  can  be  determined  if  qf s 
velocity  is  known.  This  information  can  be  sent  to  robot  i  via 
the  wireless  link  and  f  can  still  be  satisfied. 

If  one  desires  to  compose  in  parallel  (i.e.,  simultaneously 
satisfy)  multiple  objectives  encoded  by  0i, . . . ,  0p,  must 
satisfy 


■K- faiqut)  -  Ui  < 

UQi 


d<f>i(qi,  t) 
dt 


vie[i,P] 


Such  a  Ui  is  called  &  feasible  direction.  It  is  possible  to  have 
multiple  or  no  feasible  directions. 

Remark  5.2:  In  the  case  of  two  objectives  (q)  and  </>2  (q), 
with  no  explicit  time  dependence,  there  always  exists  a 
feasible  direction. 


B.  Computation 

In  [3]  an  iterative  nonlinear  programming  method  was 
introduced  to  compute  u  which  was  expensive  but  worked 
well  in  arbitrary  dimension.  Here  we  streamline  the  algorithm 
for  use  in  R2  and  guarantee  that  it  terminates  in  fixed  number 
of  steps.  The  algorithm  is  illustrated  in  Algorithm  1  and  in 
Figure  5.  Each  input  vector,  vi,...,vp,  corresponds  to  the 
negative  gradients  of  any  relevant  potentials  robot  i  must 
consider.  Typically  for  the  problems  considered  here  each 
robot  will  have  one  potential  for  the  goal,  and  up  to  two 
additional  potentials  (Range  and  Line-of-Sight)  per  desired 
communication  link  (incident  edge  in  G*).  Note  that  a  is  a 
arbitrary  weighting  factor  that  can  be  selected  off-line.  We 
use  a  =  0.5  here.  The  notation  Rot  means  to  rotate  a  vector 
about  an  axis  by  an  angle. 

There  are  P(P  —  l)/2  possible  cross  products  to  compute. 
In  R2  each  requires  3  floating  point  operations.  Therefore,  in 
the  worst  case  3 P(P  —  l)/2  operations  are  required  to  test 
feasibility.  If  the  problem  is  feasible  an  additional  16  floating 
point  operations  result  in  an  answer  for  Ui.  If  the  set  of  vectors 
has  no  feasible  solution  then  some  directions  must  be  dropped 
until  a  feasible  solution  exists.  A  prioritization  scheme  can 
be  used  for  this  purpose,  however  in  our  experience  this  is 
generally  not  necessary  for  the  class  of  problems  we  consider, 
as  discussed  in  the  following  section. 
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Fig.  5.  Given  a  series  of  possible  input  directions  v\ , . . . ,  vp,  the  algorithm 
synthesizes  a  movement  direction  u  which  is  in  the  same  half  plane  as  all 
input  vectors. 


Algorithm  1  Algorithm  for  generating  a  feasible  motion 

direction  in  M2 _ 

Function  U{  —  Feasible  Direction u2, . . . ,  vp) 
if  3va\va  x  Vj  •  k  >  0,  Vj  /  a  then 
Find  Vb\vb  xu|4<0,VI/fe 
va  =  Rot(k ,  90°)  x  va 
Vb  =  Rot(k ,  —90°)  x 

Ui  =  ava  +  (1  —  for  some  a  £  [0, 1] 

else 

Infeasible;  END 

end  if 


C.  Problem  Structure  and  completeness 

Given  an  edge  e^-  £  G*,  and  (j)900,1  and  (f)90al ,  a  feasible 
direction  always  exits  as  long  as  the  Range  and  Line-of-Sight 
constraints  are  not  simultaneously  active.  This  follows  from 
the  fact  that  given  any  two  directions,  a  feasible  direction 
always  exists  (Remark  5.2). 

Guaranteeing  the  existence  of  a  feasible  direction  when 
both  Range  and  Line-of-Sight  constraints  are  active  is  more 
difficult.  The  problem  considered  here  has  several  special 
features  worth  noting. 

Remark  5.3:  The  problem  is  planar. 

Remark  5.4:  If  ^|-</>[anpe  and  -^4>\os  are  both  nonzero, 
they  are  perpendicular  to  one  another  so  their  composition 
always  has  a  feasible  direction. 

Remark  5.5:  For  two  robots,  i  and  j  corresponding  to  the 
edge  ev ’  =  ~Wj 'P?n9e  (anti-symmetric)  and 

=  (symmetric)- 

In  light  of  these  observations  and  the  discussion  in  Sect.  V- 
A,  consider  Figure  6.  Given  an  edge  £  G*,  provided 
— and  —\7(j)9j0al  do  not  both  lie  in  the  region  labelled 
infeasible,  there  always  exists  ui  and/or  uj  which  can  simul¬ 
taneously  satisfy  each  robot’s  goal  objectives  as  well  as  the 
Range  and  Line-of-Sight  constraint  for  the  pair.  This  can  be 
verified  graphically  since  for  any  goal  direction  outside  the 
infeasible  region,  the  goal,  line-of-sight  and  range  directions 
for  a  given  robot  all  lie  in  the  same  half  plane.  And  as  long 
as  one  robot  has  a  feasible  direction,  and  knows  the  other 
robot’s  velocity  the  edge  can  be  preserved.  The  question 


Fig.  6.  A  generic  pair  of  robots,  with  active  Line-of-Sight  and  Range 
constraints.  Figure  indicates  possible  directions  of  —-§^4>9°al  that  could 
result  in  no  feasible  direction  for  simultaneously  satisfying  three  objectives. 


of  global  convergence  remains:  Is  there  any  guarantee  that 
both  robot’s  goal  vectors  will  not  simultaneously  lie  in  the 
infeasible  region? 

Conjecture :  Given  any  £  G*,  provided:  1.  the  lines 
connecting  q°  and  q or  q(  and  q J  do  not  intersect  a 
stable  manifold  discussed  in  Remark  4.2;  and  2.  obstacles 
are  convex;  a  feasible  direction  always  exists.  And,  following 
the  motion  directions  assigned  by  Algorithm  1,  the  link  e ij 
is  preserved  for  all  time  and  both  robots  i  and  j  reach  their 
goals. 

Sketch  of  proof:  If  both  robots  are  selecting  infeasible 
directions,  it  means  they  tend  to  separated  by  more  than 
Anax-  Since  the  goal  positions  are  separated  by  pmax,  the 
separation  is  not  attributed  to  the  difference  in  the  fields.  The 
separation  behavior  implies  the  points  q°  and  q°-  intersects  a 
stable  manifold.  However,  at  this  time  a  formal  proof  of  this 
conjecture  is  the  subject  of  on-going  research. 

VI.  Experiments 

MATLAB  simulations  were  used  to  demonstrate  the  algo¬ 
rithms  operation.  Figure  7  shows  a  swarm  of  5  robots  (red 
circles)  maintaining  the  five  initial  edges  shown  in  frame  1  as 
they  move  toward  the  goal  configuration.  Green  lines  indicate 
a  wireless  link.  Figure  8  depicts  the  operation  of  the  algorithm 
with  12  robots  and  15  desired  edges. 

The  above  algorithm  was  implemented  on  Koala  robots, 
made  by  K-Team,  with  an  on-board  PC  104  stack.  The  robots 
were  color  coded  and  an  overhead  camera  was  used  to  provide 
position  information  over  a  wireless  network.  Each  robot 
is  also  equipped  with  a  radio  modem  to  allow  peer-to-peer 
wireless  communication.  Figure  9  shows  three  snap  shots  of 
a  scenario.  As  the  robots  move  toward  their  goals  according  to 
(j)9°al,  the  range  constraint  becomes  active  as  seen  in  the  upper 
snapshot.  As  the  red  robot  negotiates  the  obstacle  (green), 
the  line-of-sight  constraint  between  the  red  and  orange  robots 
becomes  active  between  the  middle  and  lower  frames.  Finally 
in  the  lower  frame,  with  range  and  line  of  sight  satisfied,  the 
robots  proceed  toward  their  respective  goals  (defined  relative 
to  the  small  yellow  square).  The  control  law  easily  achieved 


950 


o1 - 1 - 1 - 1 - 1 - ' - 1 

0  50  100  150  200  250  300 

Fig.  7.  A  swarm  of  5  robots  maintaining  a  specified  communication  graph. 
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Fig.  8.  A  swarm  of  12  robots  maintaining  a  specified  communication  graph. 


Fig.  9.  Three  still  frames  from  an  experiment  showing  the  robots  coming 
together  for  communication,  avoiding  obstacles  (green  square)  and  moving 
towards  the  goal  location  (yellow  square  in  frame  3). 


“realtime”  update  rates  (>>  100  Hz),  with  the  vision  system 
serving  as  the  limiting  factor  (  10  Hz). 

VII.  Conclusion 

Motivated  by  the  use  of  wireless  communication  among 
swarm  members,  in  this  paper  we  consider  the  problem  of 
steering  N  robots  to  N  goals,  while  maintaining  some  range 
and  line  of  sight  constraints  between  them  in  the  presence 
of  obstacles.  Range  and  line  of  sight  are  two  conditions 
which  improve  the  reliability  of  wireless  transmission.  To  the 
author’s  knowledge  this  is  the  first  work  to  consider  the  effect 
of  line  of  sight  constraints  for  swarms.  After  establishing  some 
basic  conditions  on  the  existence  of  solutions,  we  show  that 
one  rather  profound  condition  is  that  all  robots  must  pass 
on  the  same  side  of  an  obstacle  (same  path-class)  for  the 
swarm  to  remain  connected.  An  implication  of  this  is  that, 
in  order  to  remain  connected,  the  swarm  must  either  have 
a  leader  or  some  on-line  method  for  achieving  consensus 
on  the  path  class.  A  further  consequence  of  this  is  that 
navigation  functions  do  not  offer  a  global  solution  to  this 
problem  because  the  existence  of  saddle  points  makes  it 
impossible  to  guarantee  all  robots  select  the  same  path  class 
for  arbitrary  initial  conditions.  Basic  potentials  for  Range  and 
Line  of  Sight  Constraints  were  introduced  and  a  method  for 
composing  multiple  potential  functions  into  a  single  feasible 
motion  direction  was  presented.  An  efficient  computational 
algorithm  to  compute  this  direction  is  proposed.  Simulations 
and  hardware  based  demonstrations  of  the  algorithm’s  opera¬ 
tion  are  provided  and  show  promising  results. 
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